Orientation Preserving Angular Swivel Joint 
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Background 

A conventional revolute or a simple swivel joint is shown in Figure 1. The conventional joint has 
one degree-of-freedom, since members 101 and 103 are only allowed to rotate about a single axis 
102 . An example of a simple swivel joint is the human elbow. 

Figure 2 depicts a conventional double revolute robotic joint, which utilizes two actuators. The 
bottom actuator orients the bending plane 95 by rotating the whole assembly about axis 91a, and 
the top actuator bends the top member 92 within that plane by rotating member 92 about axis 
92a. This joint has two independent degrees-of -freedom: orienting and bending. Since each 
degree-of-freedom is actuated by a different motor, the degrees-of-freedom are said to be 
decoupled. As it would be apparent to a person skilled in the art, the orientation of the top 
member 92 denoted by vector 94 changes as member 91 is rotated about axis 91a. The type of 
joint shown in Figure 2 is not adequate for use in a snake robot because of the relative rotation 
between members 91 and 92. Moreover, these joints present the disadvantage of being bulky 
since the top actuator is installed along axis 92a thus enlarging the joint size. 
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Shown in Figures 3a and 3b is a prior art angular swivel joint. This joint is similar to the revoiute 
joint except that the axis 1 13 of the joint is not perpendicular to either one of axis 111a and axis 
114a of members 111 and 114, respectively. Because of this, the axis 114a of the free member 
1 14 defines a cone of revolution 1 17 as it rotates about . axis 1 13, as shown in Figure 3b. 

Figures 4a and 4b depict a conventional double angular swivel joint. This joint has two motors: 
the bottom motor rotates the whole assembly about axis 11 la and the top motor rotates the top 
part 1 14 about axis 113. Thus, the top member sweeps a cone 1 17 as shown in Figure 4a, and the 
bottom motor rotates that cone as shown in Figure 4b. Since there are two actuators, this joint 
jas has no more than two degrees-of-freedom, and like the simple double revoiute joint described 
above, the two independent degrees-of-freedom are bending and orienting. Orienting is achieved 
by actuating the bottom motor. But, in order to achieve bending, the two motors must be actuated 
simultaneously in such a way that the top member stays in one plane 115. Hence, the bending 
degree-of-freedom is coupled between two motors. Like in the simple double revoiute joint 

til 

15 described above, the orientation 1 1 8 of the top member changes to 118'" which in not parallel to 
118. This means that relative rotation has occurs between the two members, and thus the double 
^= angular swivel joint caimot be used as a snake robot joint. 

Two degrees-of-freedom joints suitable for snake robots have been the subject of much research. 
The first generation of designs includes simple double revoiute joints connected to one another to 
form a snake robot. Such designs afford the robot limited capabilities and size. A more advanced 
design is the actuated universal joint. However, this design has the disadvantage of being bulky 
and has the problem of twisting. Yet another design uses an angular double swivel joint as a 
subassembly. This design has irregularity in the universal joint and has a relatively small 
strength-to-size ratio. 

The NEC Corporation snake robot is one of the first designs that use an angular double swivel 
joint as a subassembly (U.S. patent No. 4,683,4061) and is shown in Figures 19a and 19b. This 
design utilizes a relatively large universal joint to prevent any relative twist between the two 
bays. Nonetheless, this joint is heavy and bulky. Moreover, since the universal joint does not 
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transfer rotational speed between the two members linearly, the joint is difficult to control and 
the bending speed is not constant. 

The prior art also includes the JPL serpentine robot built at NASA's Jet Propulsion Laboratory 
and the California Institute of Technology shown in Figures 20a and 20b. This design is based on 
the NEC Corporation robotic joint mentioned in the immediately preceding paragraph. The JPL 
serpentine robot is 1.5 inches in diameter, approximately 3 foot long, weights 6 lbs., and has 10 
degrees-of-freedora. All joints are direct-drive motor controlled, and all motors are mounted 
internally. This design also uses a universal joint, which, in contrast with odier designs, is 
mounted inside the robot. Because the joint in mounted inside the robot, the size of the joint is 
0 limited and must be relatively small. Moreover in the JPL robot, the universal joint is necessarily 
hollow in order to run electrical connections throu2h the snake robot. This small and hollow 



w 
p 



universal joint has the disadvantage of being weak, breaking easily, and exhibiting important 
backlash and slack. 



yi The Pacific Northwest National Laboratory (PNNL) designed a 14 degrees-of-freedom arm, 

ni 

which differs from the robots descried above in that it does not use the double angular swivel 
P joint as a subassembly. It is shown in Figures 21a and 21b. This design uses a simple actuated 



universal joint similar to the double revolute joint described in Figure 2. However, this design 
uses threaded screws to actuate the universal joint making the joint strong but at the cost of being 
very slow. Additionally, this joint lacks robustness. 

With the exception of the joints used in the NEC corporation, JPL and PNNL snake robots 
described above, two degrees-of-freedom joints of the prior art cannot be used in a snake robot. 
Because there is relative twisting between the members, electrical connections running along the 
body of the robot may be severely damaged or destroyed. This relative twisting may be 
substantially reduced by introducing a third actuator for maintaining constant orientation. 
However, controlling a third actuator can be very complex and substantially adds to the cost and 
size of the joint. 
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What is needed is a swivel joint that utilizes only two actuators to extract two degrees-of- 
freedom, wherein the joint's orientation is maintained, thus making the joint adequate for use in 
a snake robot. 

Features and advantages of the joint design in accordance with the present invention 
Compactness 

The joint in accordance with the present invention has a highly compact design compared to 
prior art snake robot joint designs, and uses conventional parts (mostly off the shelf) and simple 
machining. The nominal diameter of the bays is preferably around 1.6 inches and 1.85 inches 
along the joint. The link or stage length is about 6.5 inches. These dimensions are restricted by 
the fact that off-the-shelf components are used in a preferred embodiment. However, it will 
readily appear to a person skilled in the art that a smaller or larger joint may be fabricated 
according to the particular applications the joint is designed for. In fact, the joint of the present 
invention could be as small as practicable or as big as necessary. The dimensions disclosed 
above are for the sole purpose of illustrating a preferred embodiment and are in no way meant to 
be limiting. Designs which do not use off-the-shelf components will naturally come with a 
greater cost due to the necessity to machine custom made components. 

Strength 

An important feature which set the present invention apart from the prior art is the use of angular 
bevel gears. These gears mate on the periphery of the joint diameter, and thus are capable of 
transmitting high forces and withstanding high torques. Moreover, bearings are preferably 
chosen to withstand very high loads, preferably up to 15 Newton-Meter torque or more 
depending on the application, and are preferably positioned such that they accommodate most 
high forces which the joint is subjected to and diminish these forces before transmitting them to 
the gears. In fact, the bearings take all the forces and torques that the joint faces, and the gears 



are only responsible for preventing relative twisting between the bays, which is a relatively 
minimal load. Additionally, the present joint has a high overall mechanical advantage, which 
allows the use of small motors and low torques. This prevents the need for expensive custom 
made motors. This strength of the joint is critical in all kinds of self-locomotion, climbing, 
shoring and other applications. In a preferred embodiment, the joint is capable of lifting up about 
half of the entire robot off the ground. For example, in a snake robot formed of 11 bays, the joint 
is capable of lifting up 6 bays. Naturally, a snake robot in accordance with the present invention 
may comprise as many bays as necessary. 

Rolling capability 

The joint of the present invention has an additional degree-of-freedom compared to prior art 
snake robot joints. When the joint is in the straight position, the upper and lower cups form a 
circular profile. With the gear train, the upper and lower cups can be rotated as one rigid body, 
and the gear train can thus be used as a wheel which may be utilized to create a third degree-of- 
freedom. The only constraint for this added featiue is that the joint be in the straight position. 
Therefore, this added feature is preferably only used on relatively smooth straight surfaces. In 
accordance with this invention, by only using two actuators, "two plus one" degrees-of-freedom 
can be extracted. It is to be noted, that the present joint does not have three degrees-of-freedom 
in the strict definition of the term, since the third degree-of-freedom is only available in the 
special case where the joint is in the straight position. 

Reachabilitv 

A unique feature the joint of the present invention its reachability. The present invention joint 
has a reachability of 180 degrees. Such reachability has not been achieved in the prior art. The 
present joint can bend by 90 degrees in each direction, so the range of first degree-of-freedom 
goes firom -90 to +90 degrees.. The range of the second degree-of-freedom goes from 0 to 360 
degrees. Thus, fixing one bay, the second bay can reach any point on a complete hemisphere as 




shown in Figure 22. Moreover, since the joint has a hollow assembly and further there is no 
relative twisting between the bays, the snake can move from one configuration to another, 
smoothly, quickly and efficiently, without the need to reset the joint to the straight position as is 
the case with many prior designs. 



Flexibilitv 

Another unique aspect of the joint of the present invention is its flexibility. Unlike prior art two 
degrees-of freedom joints, the present joint has infinite flexibility as illustrated in Figure 22. This 
Q means that starting from any point on the hemisphere the free end can start moving in any 
P arbitrary direction. In other words die tangent space of the free arm is a plane which is tangent to 

V:J the hemisphere. This feature is particularly important in snake robot design, since it allows the 

P ' 

snake to move "directly" from any configuration to another (using the shortest path) in minimal 

time and with minimal power consumption. This feature is also particularly important for 

yi applications where the robot is restricted to least interference with the environment. 
fU 
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Hollow Shaft assembly 

In a snake robot built witii a plurality of joints in accordance with a preferred embodiment of the 
present invention, a hole with a diameter of about preferably 0.1 to 0.5 inch, most preferably 0.3 
inch, goes through the entire lengdi of the body of the snake. Smaller and larger diameters may 
also be appropriate as well as hole having any appropriate shape know in the art. This is critical 
to snake robot design, since it allows to run electrical connections inside the snake, and these 
electrical connections are protected from the external environment. For example, one of many 
applications of a snake robot is search and rescue operation in collapsed buildings (e.g., after an 
earthquake) where a harsh, rough and dirt)' environment awaits the robot. Moreover, the hollow 
shaft can receive and protect other needed connections, such as, for example, optical fibers. 
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Orientarion presendng 



In the present design, the bays bend in the desired configuration without any relative twist 
between the bays. This is critical for running wires through the inside of the snake without 
risking to damage the wires. In this manner, wires only bend, but would not twist, which is 
mechanically safe for electrical wires. Thus, a snake robot in accordance with the present 
invention may go from a given configuration to another veiy quickly and smoothly without any 
concern for mechanical failure of the wires. In other words the motors can be continuously 
actuated for any desired mode of motion, such as bending or orienting or any other mode. In 
particular we can actuate our joint to be m orientating mode when it is in the straight position. In 
this case (straight position) a third degree-of-freedom is available: rolling. Thus, the present 
novel mechanism is able to produce three modes of motion with a simple controller, such as, but 
not limited to, a simple on/off switch. The controller's functions only need to be as simple as 
actuating the motors with the same speed but with equal or different orientations. The joint can 
be actuated by simply turning the motors on or off, and no compUcated controller to 
continuously vary the speed of the motors is needed. 

Linear control 

In a preferred embodiment of the present invention, there is a linear relation between the motor 
speed and the azimuth and elevation angles. Thus, a simple linear controller may be used. The 
motors are preferably run in a continuous linear mode in order to produce continuous smooth 
bending and orientation. This is due to an angular bevel mechanism, which provides continuous 
motion between the bays. In contrast, the universal joint mechanisms of the prior art have a non- 
constant motion transfer, which leads to complex control and non-smooth behavior or the joint. 



Summary 



It is an object of this invention to provide a joint assembly, which is suitable for building snake 
robots. Joints of the present invention may be connected to other joints of the present invention 
to form a snake robot. The snake robot may also comprise a number of motors to actuate the 
joints and impart motion on the snake robot and/or configure the snake robot in the desired 
configuration or shape. 

It is another object of this invention to provide a joint, which is hght, compact, strong and easily 
p controllable. It is yet another object of this invention to provide a joint , which can be used in all 
P kinds of mechanical robotic arms. 

p The jomt m accordance with the present invention comprises two members and an angular bevel 
gear train that connects the two members of the joint. The gear train allows an actuator to be 
p positioned along the axis of the joint while transferring forces to the periphery of the mechanism, 
^ ! thus creating a high mechanical advantage proportional to the radius of the robot. The gear train 
U] also minimizes the stresses and torques on the joint components. The joint is capable of 
|1j producmg high forces and resisting high loads, both being critical aspects of many snake robot 
appUcations. Preferably, the joint may produce a torque as high as about 5 Newton^Meters or 
higher with a safety factor of 2, and thus can preferably resist forces of the same order of 
magnitude. As the skilled person wiU appreciate, these values will depend on the particular 
application of the joint, and accordingly, a wide range of values, higher or lower are also 
appropriate. Moreover, the gear train is capable of transferring rotational motion between the two 
members with a constant ratio. This constant ratio renders die joint easy to control and simpUfies 
the inverse kinematics of the joint. Indeed, for any configuration of the joint, the motor rotations 
needed to obtain that configuration can be easily be calculated and implemented. 

It is another object of this invention to provide a joint with a hollow assembly that allows 
electrical wires and circuitry to run inside the joint, thus protecting the wires from harsh 
environmental conditions in which the joint may be placed. 
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It is a further object to provide a joint that does not allow relative rotation between the two bays 
connected to the joint, thereby preventing the electrical wires from being twisted, and thus 
avoiding failure. 

It is another object of this invention to provide a joint which is easy to build and which uses off 
the shelf elements except for a limited number of elements which are preferably machined. 

Brief description of the drawings 

Figure 1 shows a conventional simple swivel joint; 
Figure 2 shows a conventional double swivel joint; 
Figures 3a, 3b, 4a and 4b depict a conventional angular swivel joint; 

Figures 5a and 5b show the upper half subassembly of a joint in accordance with a preferred 
embodiment of the present invention; 

Figures 6a and 6b show the upper lower subassembly of a joint in accordance with a preferred 
embodiment of the present invention; 

Figures 7a and 7b show the upper and lower cup of a joint in accordance with a preferred 
embodiment of the present invention; 

Figure 8 shows and angular bevel gear train of a joint in accordance with a preferred 
embodiment of the present invention; 

Figures 9a and 9b illustrates the assembly of the upper and lower cups of a joint in accordance 
with a preferred embodiment of the present invention; 




Figure 10 shows how the bevel gear train connects to the lower half subassembly of a joint in 
accordance with a preferred embodiment of the present invention; 

Figures 11a and lib illustrate the motion of the angular bevel gear train as the lower cup is 
rotated; 

Figure 12 is a perspective view of the upper and lower cups illustrating how they are connected 
in accordance with a preferred embodiment of the present invention; 

h Figure 13 is a perspective view of a portion of a joint in accordance with a preferred embodiment 

P 

of the present invention; 

N Figure 14 illustrates the kinematics of a joint in accordance with a preferred embodiment of the 
present invention; 

O 

iJ1 Figures 15a and 15b show a perspective view of a joint in accordance with a preferred 

fU 

embodiment of the present invention, illustrating the kinematics of the joint; 

to 
hJ 

Figures 16a and 16b illustrates the kinematics of the lower half subassembly of a joint in 
accordance with a preferred embodiment of the present invention; 

Figures 17a and 17b illustrates the kinematics of the upper half subassembly of a joint in 
accordance with a preferred embodiment of the present invention; 

Figures 1 8a and 18b are graphs showing the variation the elevation and azimuth angles; 

Figures 19a and 19b show a prior art snake robot design; 

Figures 20a and 20b show a prior art serpentine robot; 

Figures 21a and 21b show yet another prior art snake robot designs; 



10 



Figure 22 illustrates the infinite flexibilit>' of a joint in accordance with the present invention; 



Figure 23 is a perspective view showing a section of a joint in accordance with a preferred 
embodiment of the present invention; 



Figure 24 is a schematic showing the dimension of an embodiment of a joint in accordance with 
the present invention; 



jsi Figure 25 shows a snake robot built with joints of the present invention. 

P 
P 
P3 
W 

H Detailed description 

P 
U1 

Turning to Figures 5a and 5b, the upper half subassembly 1 of the joint is shown. First bay 1 1 is 

yi coupled to obliquely cut upper cup 15 by first and second upper ansular bearinss 13. Bearinss 

(IJ 

13 allow upper cup 15 to rotate freely about axis OZ' with respect to first bay 11 with minimal 
friction. Additionally, bearings 13 hold upper spur gear 10 into position as spur gear 10 is 
sandwiched between the two bearings 13, upper spur gear 10 being fixedly mounted on upper 
cup 15. Preferably, two bearings 13 are used to ensure free rotation of upper cup 15 about axis 
OZ' with no or very minimal wobbling. Upper cup 15 and upper spur pinion gear 10 are 
preferably bolted together, preferably using a circular array of bolts. However, other ways known 
in the art of fixedly mounting two elements may be used as well (e.g., welding). Thus, upper cup 
15 and upper spur gear 10 may rotate as one rigid body. Bolting together the upper cup 15 and 
upper spur gear 10 has the advantage that the two elements may be disassembled. Upper spur 
pinion gear 14 is mounted on upper motor shaft 12 and mates with upper spur gear 10. Upper 
spur pinion gear 14 is fixedly connected to upper motor shaft 12 preferably via a setscrew, or 
alternatively using a spline. The upper motor housing (not shown) is preferably connected to first 
bay 11. In this manner the upper motor (not shown) rotates the upper cup 15 freely around axis 
OZ', and axis 15a prescribes a cone of revolution 16 upon rotation about axis OZ'. The rotation 
about axis OZ' of upper cup 15 with respect to first bay 1 1, is carried out by actuating the upper 
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motor to rotate upper motor shaft 12 about the axis of the shaft 12, which in turn rotates upper 
spur pinion gear 14 fixedly mounted on upper motor shaft 12. Since upper spur pinion gear 14 
mates with upper spur gear 10, and is rotatably coupled thereto, the rotation of upper spur pinion 
gear 14 drives upper spur gear 10 to rotate about axis 0Z\ thereby rotating upper cup 15 with 
respect to first bay 11. 

The lower half subassembly 2 of the joint is shown in Figures 6a and 6b. The elements included 

in lower half subassembly 2 are preferably identical to the elements included in the upper half 

subassembly 1, except for lower cup 25 which differs fi-om upper cup 15 in that part of the lower 

cup 25 is made to fit within part of the upper cup 15 as explained below. Thus, the description of 

fl the upper half subassembly 1 given in the immediately preceding paragraph applies, mutatis 

p . 

P2 mutandis, to the lower half subassembly 2. In particular, in the above description the reader will 

^ substitute first bay 11, upper cup 15, upper angular bearings 13, upper spur gear 10, upper spur 

P pinion gear 14, upper motor shaft 12, upper motor housing, upper motor, axis OZ', axis 15a, and 

^ cone of revolution 16, with second bay 21, lower cup 25, lower angular bearings 23, lower spur 
gear 20, lower spur pinion gear 24, lower motor shaft 22, lower motor housing, lower motor, axis 

Ms 

flj OZ, axis 25a, and cone of revolution 27, respectively. 
Ul 

9 

fy Preferably, the upper cup 15 and the lower cup 25 are fabricated from a generally cylindrical 
body 55 as shown in Figures 7a and 7b. Body 55 has a major cylindrical portion 59 ending, on 
the upper side, with upper conical portion 51 and upper minor cylindrical portion 60, and, on the 
lower side, with the lower conical portion 52 and lower minor cylindrical portion 61. As shown 
in Figure 7b, body 55 has a hollow interior and a circular cross-section, and both the upper and 
lower conical portions 51 and 52 also have a circular cross-section. The wall of body 55 has a 
thickness preferably ranging from about 0.1 inches to about 0.25 inches. This thickness may vary 
depending upon the design requirements for different applications of the joint. Upper cup 15 and 
lower cup 25 are preferably manufactured using a lathe with two different milling angles. The 
outside profile is shaped as shown in Figure 7a, and then cut along plane 53. Milling of the inside 
is done on each of the two parts separately. The axis of milling the inside is perpendicular to 
plane 53. 
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Upper cup 15 and lower cup 25 are obtained by cutting body 55 along plane 53, which plane 53 
intersects the axis of revolution of body 55 at an angle 0=45"*. Each of the halves of body 55 
thus obtained are then machined to create upper cup 15 and lower cup 25. As seen in Figure 5a, 
5b, 9a and 9b, upper cup 15 is machined so as to create upper cup internal circular flange 54 and 
upper cup intemal circular ledge 57. Lower cup 25 is machined so as to create lower cup internal 
circular flange 66, lower cup intemal circular ledge 58, , lower cup first external circular flange 
64, lower cup first external circular ledge 63, lower cup second external circular flange 56 and 
lower cup second external ledge 65. When the joint is assembled.as shown in Figure 9b, upper 
cup 15 and lower cup 25 are coupled via inter-cup bearing 26, lower cup first external circular 
flange 64 receives the inside ring of inter-cup bearing 26 and is fixedly connected thereto, while 
upper-cup intemal circular flange 54 receives the outside ring of inter-cup bearing 26 and is 
fixedly coupled thereto. Further, the outer ring of inter-cup bearing 26 rests on upper cup intemal 
ledge 57, and the inner ring of inter-cup bearing 26 rests on lower cup first external ledge 63. In 
this manner, bearing 26 allows upper cup 15 and lower cup 25 to rotate with respect to one 
another. During coupling of upper cup 15 and lower cup 25, axes 15a (On') and 25a (On) are 
aligned in such a way that the two axes are anti-parallel. This allows the upper subassembly 1 
and lower subassembly 2 to rotate freely about axes 1 5a (or 25a). 

Since the upper half subassembly 1 and the lower half subassembly 2 are identical but for upper 
cup 15 and lower cup 25, identical elements may be used to construct both the upper and lower 
half subassemblies of the joint. This greatly simplifies the manufacturing of the joint elements 
and reduces the cost of the joint. 

First bay 11 is then connected to second bay 21 by introducing angular bevel gear train 3, as 
shown in Figure 8. This assures that die first and second bays are connected via a smooth, strong 
and compact gear train. Bevel gear train 3 has a constant velocity transfer, which prevents 
irregularity and hence affords the joint a constant bending velocity. Bevel gear train 3 comprises 
first bevel pinion 30 coupled to first bevel gear 31, bevel gear bearing 34 connected on one side 
to first bevel gear 31 and on the other side to second bevel gear 32, and second bevel pinion 33. 



13 



Figure 10 shows how bevel gear train 3 connects to the lower half subassembly 2 of the joint. 
Bevel pinion 33 is fixedly connected to second bay 21. The first and second bevel gears 31 and 
32 are bolted together and squeeze the inner ring of bearing 34 between them. The outer ring of 
bearing 34 is fixedly connected to lower cup 25, preferably by being clamped thereto. The outer 
ring of bearing 34 mates lower cup internal circular flange 66 and in squeezed between lower 
cup ihlemal circular ledge 58 and second retaining ring 17. In this manner, axis 25a (On) of 
lower cup 25 is aligned with axis 31a of first bevel gear 31. As described in connection with 
Figure 6b, axis 25a (On) prescribes a cone of revolution 27 as lower cup 25 is rotated, therefore, 
axis 31a prescribes the same cone of revolution 27 as lower cup 25 is rotated. 

Figures 1 la and 1 lb show how bevel gear train 3 acts as lower cup 25 is rotated about axis OZ. 
As the motor rotates lower cup 25, axis On (25a, 31a) start traversing cone of revolution 27, as 
described in Figure 6b. Consequently, the mating point of second bevel gear 32 goes around 
bevel pinion 33. Thus, in order to have nearly perfect or at least efficient mating between gears, 
first and second bevel gears 31 and 32 must rotate about axis On [25a, 31a]. After rotating lower 
cup 25, vector 35 in Figure 1 la becomes vector 35' in Figure 1 lb. This rotation is made possible 
by bearing 34, seen in Figures 8 and 9, which allows first and second bevel gears 31 and 32 to 
rotate freely around axis On. 

As described in the foregoing, upper cup 15 and lower cup 25 are connected by inserting bearing 
26 between the two cups as shown in Figures 9a, 9b and 12. In particular, the outer ring of 
bearing 26 is pressed against upper cup internal flange 54 of upper cup 15 to ensure that bearing 
26 staj's in place. This is preferably realized by bolting first retaining ring 28 to upper cup 15 
such that the outer ring of bearing 26 is squeezed between upper cup internal ledge 57 and first 
retaining ring 28. The inner ring of bearing 26 is pressed against lower cup first external flange 
64 of lower cup 25. This is preferably realized by bolting second retaining ring 17 to lower cup 
25 such that the inner ring of bearing 26 is squeezed between lower cup first external ledge 63 
and second retaining ring 17. Second retaining ring 17 also presses the outer ring of bearing 34 
against lower cup internal ledge 58 of lower cup 25. 
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Figure 13 shows a preferred embodiment of a joint in accordance with the present invention with 
all the components in place, This joint has two decoupled degrees of -freedom; hence it can 
behave as a double revolute joint such as described in Figure 2, and, in addition, it has the 
property of maintaining the orientation of the second member. 

First bay 11, second bay 21, upper cup 15, lower cup 25, first retaining ring 28 and second 
retaining ring 17 are preferably machined from materials with both high strength and low density 
in order to make the joint both strong and light weight. A preferred material is aluminum, but 
other adequate materials will suggest themselves to a person skilled in the art. The other 
elements such of the joint such as bearings and gears are preferably off-the-shelf elements. Of 
course, these elements may be machined as well, for applications which require joints of a 
different size from the joint shown in Figure 24 (dimensions are shown in inches). 

Figure 25 shows a snake robot in accordance with the present invention, wherein a plurality of 
joints is used to form a snake robot. Preferably, each joint is connected to the next joint by 
connecting together one of their respective bays as show in Figure 25. The number of joints used 
will determine the length of the snake robot, which will vary with the application the snake robot 
is designed for. Motors which actuate the joints of the robot are housed in the bays. Preferably, 
two motors are used to actuate each joint. The snake robot is placed in the desired configuration 
by actuating the pertinent joints. The Kinematics of the joint is described below. 



15 



Kinematics of the Joint 



In this section, we will study the kinematics of our joint. By the end of this section we will have a result that relates 
the motors rotations to the final configwation of the free end of the snake. Now we will clear some concepts in 
order to help understanding the figures in this section. Referring to Figure 14, assume that the lower member [80] 
of the joint is fixed. Then a point [p] on the free member (81] traverses the hemisphere [83). Let vector V represent 
the upper free end. So for any configuration of the joint, we can project point \p] on the [oXYZ] axes and get the 
components of V. Let [x], [y] and [z\ be the projections of point [p] on the axes [oX], [oY] and [oZ] respectively. 
The elevation angle is the angle that the free end makes with the [oZ] axis, and it is donated by [<^], i.e. cos(^) = 
The azimuth angle is the angle that the [oh], the projection of [op] on the [Xoy] plane, makes with [oX], and it is 
denoted by [6], i.e. tan(^) = ^. 

Figures 15a and 156 annotate the angles of the joint. [6l\ and [6u] denote the angle of rotation of the lower motor 
and the upper motor respectively. [0l] and [0u] denote the angle or rotation with respect to the lower and upper 
cups respectively. We have 6 = Ki.p where Ki is the gear ratio between the motor shaft and the cups. In our case 
Ki = 2.5. [ai] and [au] denote the angle of rotation that the bevel gear rotates with respect to the lower and upper 
cup respectively, [a] is the £uigle of rotation between the two cups. From Figure 156 a = ai, -\- a^. But since the 
gear ratio between the bevel gears is one, then a = 0, 

Figures 16a and 166 depict a kinematics diagram of the lower part of the joint. It is drawn with four set of reference 
frames. The frames transfer the coordinate system from the lower bay to the bevel gear in the middle of the joint. To 
find this transformation matrix Tf^^^'^, one must find the intermediate matrices between the intermediate frames. 
The origins of all the firames coincide. Frame oxoyozo is attached to the lower bay. Frames oxiyizi and 0x22/2^2 
are attached to the lower cup. Frame 0x32/323 is attached to the bevel gear. Tj transforms frame oxoyo^o to frame 
oxiyiZi after rotating around 020 by /?x, degrees. Tf transforms frame oxiyiZi to firame 0x22/2-^2 after rotating 
around oyi by 45 degrees. T2 transforms firame 0x22/2^2 to frame 0x31/323 after rotating around 022 by — /?£, degrees. 
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Then: 



cos{Pl) s\n{0L) 0 
-sin(/3i) cos(;9£,) 0 
0 0 1 



cos(45) 0 - sin(45) 

0 1 0 
sin(45) 0 cos(45) 



T3 = 



cosC^') sm{^) 0 
-sin(^) cos(^) 0 



Hence:Tf-t = Tg = TI-T^.TS = 



sin(<3.)cos(^0 -cos(;9^)sin(/3^) 

cos(j9L) 



COsi0L) 



^+cos2(/?i) 



v/2 



sin(gL) 
1 

75 



Matrix Tf^^'^ transforms the coordinate system from the lower bay to the bevel gears. But, since the joint is 
symmetric about the bevel gear, Figures 17a and 176, then the transformation matrix that transforms the upper bay 
coordinate system to the bevel gears is the same. 

Hence, T^pp^J. = T^^^'^. But since these matrices are rotation matrices, orthonormal, their inverse is equal to 
the transpose of the matrix. Hence, T^^^^|."^ = T^^^^J.^ = Tf^^J^^. In order to get the transformation matrix 
from the lower bay to the upper bay, we must multiply all the matrices. T^^w^^r = '^flJie'r^-^ '^ foxier where matrix 
A aligns the axes on the bevel gear by rotating the frame around oy^ or 07/3 by 180 degrees. Let V be a vector that 
represents the upper bay in the oxqIJqZq, Then V = T^^g^.V where V is the representation of the upper bay in 
the lower bay reference frame 0x03/0 ^o- 



A = 



-1 


0 


0 






0 


1 


0 


V = 


Vy 


0 


0 


-1 






^ = [0 


0 


1]''. 


Hence, V' is: 



^[cos^(Pl)cos{Pu) + V^cos(j9c/)sin2(^x,) +cos(/?x,)(^l + (-1 + v^)sin(i8£,)sin{)9y))] 
i[-sin2(/?^)sin(/3c/) - N^sin(/?t/)cos2(j9^) - sin{/3L)(-l - (-1 + >/2)cos(j9l) cos(j9t/))] 

c2/ 



where Pi and Pu are the angles of rotation of the lower and upper cup with respect to the lower and upper bay 
respectively, \\V'iPLiPu)\\ = 1 for any Pl and Pu. Notice that: 





" v'+ ' 




V'+(/3,/3) = 













(1- v^)cos(/3)sin(/?)2 
-i(l + n/2 + (-1 + n/2) cos(2j9)) sin()3) 

C0S(;9)2 





(1 - N/2)cos()3)sin(;8)2 








A(l + n/2 + (-1 + n/2) cos(2;3)) sin(/3) 








cos03)2 







(1) 



(2) 
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V'-(A-/3)=V'-(-/?,/3) = 



0 



(3) 



1 

Notice that in equations (1) and (2), Pl = Pu =^ P or Pi = Pu = -P- This means that the motors are spinning 
in the same direction. V'^ = V^ziPiP) = z{-P, -P) = cos^(j9). The elevation angle 0 and the azimuth angle 9 
are: 



Figures 18a and 186 show how the elevation 0 and azimuth 9 angles change versus p. The elevation angle is 
the same whether Pi = Py = p or P^ = Pu — -P- But the azimuth angle changes sign (Figure 18a). This means 
that the joint will start bending in the positive oy direction or the negative oy direction depending on whether 
Pl = Pu = P or Pl = Pu = —P- Moreover, the azimuth angle is very small and almost zero. This means that 
rotating both motors in the same direction whether in the positive or the negative direction will bend make the joint 
bend in one plane. Hence the first degree-of-freedom which is in-plane bending. 

Assume that the joint is in arbitrary configuration, then V = [Ki Vy . If the motors are spinning in 

opposite direction this will change the azimuth angle 9. This gives the second degree-of-freedom which is orienting. 

From equation (3), where Pl = -Pu = P or Pl = -Pu = -P, V" = [0 0 1]^. This proves that if the joint 
is straight and the motors are spinning in opposite directions, the snake stays upright. So spinning the motors in 
opposite direction changes the orientation of the bevel gears and rotates both lower and upper cup as one rigid body. 
Since the cups have a circular profile they could be used as a wheel. This gives the third degree-of-freedom with is 
rolling. 



<j) = cos ^( 




) = cos~Hcos2(/?)), 



IIV'II 
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♦ • 

Having described the invention in connection with certain embodiments thereof, modification 
udll now certainly suggest itself to those skilled in the art. As such, the invention is not to be 
limited to the disclosed embodiments except as required by the appended claims. 
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